4.1 Forward Kinematics